Header header
int16 robot_id
float64 r_x_pos
float64 r_y_pos

int16[] primitive_id
float64[] p_x_pos
float64[] p_y_pos
float64[] p_r_weight
bool[] target_exist

target_node[] connect_target